home *** CD-ROM | disk | FTP | other *** search
/ Chip 2005 August (Alt) / CHIP 2005-08.1.iso / program / guvenlik / syslinux-3.07.exe / com32 / modules / ethersel.c < prev    next >
Encoding:
C/C++ Source or Header  |  2005-01-05  |  5.7 KB  |  283 lines
  1. #ident "$Id: ethersel.c,v 1.3 2005/01/05 07:30:47 hpa Exp $"
  2. /* ----------------------------------------------------------------------- *
  3.  *   
  4.  *   Copyright 2005 H. Peter Anvin - All Rights Reserved
  5.  *
  6.  *   This program is free software; you can redistribute it and/or modify
  7.  *   it under the terms of the GNU General Public License as published by
  8.  *   the Free Software Foundation, Inc., 53 Temple Place Ste 330,
  9.  *   Boston MA 02111-1307, USA; either version 2 of the License, or
  10.  *   (at your option) any later version; incorporated herein by reference.
  11.  *
  12.  * ----------------------------------------------------------------------- */
  13.  
  14. /*
  15.  * ethersel.c
  16.  *
  17.  * Search for an Ethernet card with a known PCI signature, and run
  18.  * the corresponding Ethernet module.
  19.  *
  20.  * To use this, set up a syslinux config file like this:
  21.  *
  22.  * PROMPT 0
  23.  * DEFAULT ethersel.c32
  24.  * # DEV [DID xxxx:yyyy[/mask]] [RID zz-zz] [SID uuuu:vvvv[/mask]] commandline
  25.  * # ...
  26.  * 
  27.  * DID = PCI device ID
  28.  * RID = Revision ID (range)
  29.  * SID = Subsystem ID
  30.  */
  31.  
  32. #include <inttypes.h>
  33. #include <stdio.h>
  34. #include <stdlib.h>
  35. #include <string.h>
  36. #include <console.h>
  37. #include <sys/pci.h>
  38. #include <com32.h>
  39.  
  40. #ifdef DEBUG
  41. # define dprintf printf
  42. #else
  43. # define dprintf(...) ((void)0)
  44. #endif
  45.  
  46. struct match {
  47.   struct match *next;
  48.   uint32_t did;
  49.   uint32_t did_mask;
  50.   uint32_t sid;
  51.   uint32_t sid_mask;
  52.   uint8_t rid_min, rid_max;
  53.   char *filename;
  54. };
  55.  
  56. static const char *
  57. get_config(void)
  58. {
  59.   static com32sys_t r;
  60.  
  61.   r.eax.w[0] = 0x000E;
  62.   __intcall(0x22, &r, &r);
  63.  
  64.   return MK_PTR(r.es, r.ebx.w[0]);
  65. }
  66.  
  67. static char *
  68. skipspace(char *p)
  69. {
  70.   while ( *p && *p <= ' ' )
  71.     p++;
  72.  
  73.   return p;
  74. }
  75.  
  76. #define MAX_LINE 512
  77.  
  78. /* Check to see if we are at a certain keyword (case insensitive) */
  79. static int looking_at(const char *line, const char *kwd)
  80. {
  81.   const char *p = line;
  82.   const char *q = kwd;
  83.  
  84.   while ( *p && *q && ((*p^*q) & ~0x20) == 0 ) {
  85.     p++;
  86.     q++;
  87.   }
  88.  
  89.   if ( *q )
  90.     return 0;                   /* Didn't see the keyword */
  91.  
  92.   return *p <= ' ';             /* Must be EOL or whitespace */
  93. }
  94.  
  95. static char *
  96. get_did(char *p, uint32_t *idptr, uint32_t *maskptr)
  97. {
  98.   unsigned long vid, did, m1, m2;
  99.  
  100.   *idptr   = -1;
  101.   *maskptr = 0xffffffff;
  102.  
  103.   vid = strtoul(p, &p, 16);
  104.   if ( *p != ':' )
  105.     return p;            /* Bogus ID */
  106.   did = strtoul(p+1, &p, 16);
  107.  
  108.   *idptr = (did << 16) + vid;
  109.  
  110.   if ( *p == '/' ) {
  111.     m1 = strtoul(p+1, &p, 16);
  112.     if ( *p != ':' ) {
  113.       *maskptr = (m1 << 16) | 0xffff;
  114.     } else {
  115.       m2 = strtoul(p+1, &p, 16);
  116.       *maskptr = (m1 << 16) | m2;
  117.     }
  118.   }
  119.  
  120.   return p;
  121. }
  122.  
  123. static struct match *
  124. parse_config(const char *filename)
  125. {
  126.   char line[MAX_LINE], *p;
  127.   FILE *f;
  128.   struct match *list = NULL;
  129.   struct match **ep = &list;
  130.   struct match *m;
  131.  
  132.   if ( !filename )
  133.     filename = get_config();
  134.  
  135.   f = fopen(filename, "r");
  136.   if ( !f )
  137.     return list;
  138.  
  139.   while ( fgets(line, sizeof line, f) ) {
  140.     p = skipspace(line);
  141.  
  142.     if ( !looking_at(p, "#") )
  143.       continue;
  144.     p = skipspace(p+1);
  145.  
  146.     if ( !looking_at(p, "dev") )
  147.       continue;
  148.     p = skipspace(p+3);
  149.  
  150.     m = malloc(sizeof(struct match));
  151.     if ( !m )
  152.       continue;
  153.  
  154.     memset(m, 0, sizeof *m);
  155.     m->rid_max = 0xff;
  156.  
  157.     for(;;) {
  158.       p = skipspace(p);
  159.  
  160.       if ( looking_at(p, "did") ) {
  161.     p = get_did(p+3, &m->did, &m->did_mask);
  162.     m->did_mask = 0xffffffff;
  163.       } else if ( looking_at(p, "sid") ) {
  164.     p = get_did(p+3, &m->sid, &m->sid_mask);
  165.       } else if ( looking_at(p, "rid") ) {
  166.     unsigned long r0, r1;
  167.  
  168.     p = skipspace(p+3);
  169.  
  170.     r0 = strtoul(p, &p, 16);
  171.     if ( *p == '-' ) {
  172.       r1 = strtoul(p+1, &p, 16);
  173.     } else {
  174.       r1 = r0;
  175.     }
  176.  
  177.     m->rid_min = r0;
  178.     m->rid_max = r1;
  179.       } else {
  180.     char *e;
  181.  
  182.     e = strchr(p, '\n');
  183.     if ( *e ) *e = '\0';
  184.     e = strchr(p, '\r');
  185.     if ( *e ) *e = '\0';
  186.  
  187.     m->filename = strdup(p);
  188.     if ( !m->filename )
  189.       m->did = -1;
  190.     break;            /* Done with this line */
  191.       }
  192.     }
  193.  
  194.     dprintf("DEV DID %08x/%08x SID %08x/%08x RID %02x-%02x CMD %s\n",
  195.         m->did, m->did_mask, m->sid, m->sid_mask,
  196.         m->rid_min, m->rid_max, m->filename);
  197.  
  198.     *ep = m;
  199.     ep = &m->next;
  200.   }
  201.  
  202.   return list;
  203. }
  204.  
  205. static struct match *
  206. pciscan(struct match *list)
  207. {
  208.   unsigned int bus, dev, func, maxfunc;
  209.   uint32_t did, sid;
  210.   uint8_t hdrtype, rid;
  211.   pciaddr_t a;
  212.   struct match *m;
  213.  
  214.   for ( bus = 0 ; bus <= 0xff ; bus++ ) {
  215.     for ( dev = 0 ; dev <= 0x1f ; dev++ ) {
  216.       maxfunc = 0;
  217.       for ( func = 0 ; func <= maxfunc ; func++ ) {
  218.     a = pci_mkaddr(bus, dev, func, 0);
  219.  
  220.     did = pci_readl(a);
  221.     
  222.     if ( did == 0xffffffff || did == 0xffff0000 ||
  223.          did == 0x0000ffff || did == 0x00000000 )
  224.       continue;
  225.  
  226.     hdrtype = pci_readb(a + 0x0e);
  227.  
  228.     if ( hdrtype & 0x80 )
  229.       maxfunc = 7;        /* Multifunction device */
  230.  
  231.     if ( hdrtype & 0x7f )
  232.       continue;        /* Ignore bridge devices */
  233.  
  234.     rid = pci_readb(a + 0x08);
  235.     sid = pci_readl(a + 0x2c);
  236.  
  237.     dprintf("Scanning: DID %08x SID %08x RID %02x\n", did, sid, rid);
  238.  
  239.     for ( m = list ; m ; m = m->next ) {
  240.       if ( ((did ^ m->did) & m->did_mask) == 0 &&
  241.            ((sid ^ m->sid) & m->sid_mask) == 0 &&
  242.            rid >= m->rid_min && rid <= m->rid_max )
  243.         return m;
  244.     }
  245.       }
  246.     }
  247.   }
  248.  
  249.   return NULL;
  250. }
  251.  
  252. static void __attribute__((noreturn))
  253. execute(const char *cmdline)
  254. {
  255.   static com32sys_t ireg;
  256.  
  257.   strcpy(__com32.cs_bounce, cmdline);
  258.   ireg.eax.w[0] = 0x0003;       /* Run command */
  259.   ireg.ebx.w[0] = OFFS(__com32.cs_bounce);
  260.   ireg.es = SEG(__com32.cs_bounce);
  261.   __intcall(0x22, &ireg, NULL);
  262.   exit(255);  /* Shouldn't return */
  263. }
  264.  
  265. int main(int argc, char *argv[])
  266. {
  267.   struct match *list, *match;
  268.  
  269.   openconsole(&dev_null_r, &dev_stdcon_w);
  270.  
  271.   list = parse_config(argc < 2 ? NULL : argv[1]);
  272.  
  273.   match = pciscan(list);
  274.  
  275.   if ( match )
  276.     execute(match->filename);
  277.  
  278.   /* On error, return to the command line */
  279.   fputs("Error: no recognized network card found!\n", stderr);
  280.   return 1;
  281. }
  282.  
  283.